/*
 * sys_task.c
 *
 *  Created on: Dec 4, 2023
 *      Author: boen
 */

#include <sys_task.h>
#include "tim.h"

/**
  * @brief  Function implementing the sysTask thread.
  * @param  argument: Not used
  * @retval None
  */
void sys_task(void *argument)
{
	/* USER CODE BEGIN sys_task */
	key_init();
	imu_init();
	mobile_init();
	manipulator_init();
	/* Infinite loop */
	for(;;)
	{
		key_polling();
		imu_polling();
		mobile_polling();
		manipulator_polling();
		osDelay(TASK_THREAD_DELAY);
	}
	key_deinit();
	imu_deinit();
	mobile_deinit();
	manipulator_deinit();

	/* USER CODE END sys_task */
}
